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Abstract 


Automatic  fastening  (eg,  snap  fasteners)  is  a  central  theme  in  manufacturing  and 

design  foAassembly.  Snap  fasteners  We  non-rigid  bodies,  and  hence  predicting  the  motion  of) 


called  "pawls  can  contact  with  immovable  planar  obstacles.  As  the  motion  proceeds,  the  pawls  s' 
deform  (deflect)  around  the  obstacles\in  response  to  the  kinematic  constraints  and  the  frictional  f  D 
contact  forces.  The  pawls  can  also  “snap”  off  an  obstacle  edge  towards  their  zero  position;  l  cG 
this  motion  is  modeled  using  a  pure  rotation.  The  simulation  problem  is  to  determine  the  \^s’" 
motion  of  the  pawls  as  parameterized  by  the  translation  distance  of  the  root,  and  to  compute 
the  termination  configuration  of  the  system  if  it  is  reachable.»cThe  solution  trajectory  $  of 
the  system  is  piecewise  cubic  in  the  configuration  space,  and  the\dynamics  may  be  reduced  to  ......  ,  _ 

erecting  cubic  “local”  configuration  space  constraints.  The  simuk  tion  never  leaves  a  connected  -1  Fot 
component  F  of  configuration  space.  We  can  compute  the  solution  $  by  sweeping  k  planar  slices  .jj 
of  F  (each  slice  is  a  planar  arrangement  of  cubic  curves).  Each  s  ice  has  complexity  0(Ar(n)), 
and  can  be  constructed  efficiently  using  a  red-blue  merge  algor  thm  (r  is  a  small  constant).  •£ 
Reducing  motion  prediction  to  sweeping  a  planar  arrangement  o  curves  allows  us  to  solve  the  tloa. 
simulation  problem  exactly  in  0(kXr(n)  log2  n)  time.  I . . . 
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1  Introduction 

Previous  work  on  algorithmic  motion  planning  has  largely  concentrated  on  the  movement  problem 
for  rigid  bodies  [LoP,Don,Yap].  Recently,  work  in  compliant  motion  planning  under  uncertainty 
(LMT,  Erd,  CR,  Don2,  Don3,  Can2,  Bri,  FHS]  has  focused  on  the  problem  of  moving  rigid  objects 
(e.g.  pegs)  in  contact  (i.e.,  compliantly)  with  obstacles  (such  as  holes)  under  force-control,  subject 
to  bounded  uncertainty  and  error.  The  only  combinatorially  precise  results  that  have  been  obtained 
for  compliant  motion  have  been  for  pure  translations.  Hence  they  are  essentially  inapplicable  for 
any  real  systems,  which  typically  can  rotate.  Indeed,  planning  and  simulation  for  systems  with 
rotational  bodies  and  rotational  compliance  has  resist*  .1  solution  in  the  sense  that  only  approximate, 
heuristic,  or  numerical  algorithms  are  known.  We  consider  a  mechanical  system  of  bodies  that  can 
compliantly  slide  on  obstacles  while  they  translate  a.id  rotate  in  the  plane.  We  provide  an  exact, 
efficient  algorithm  for  predicting  the  motion  of  these  rather  interesting  devices,  which,  as  we  we 
discuss  below,  are  important  in  manufacturing,  design,  and  f.cto'.y  assembly.  The  key  ideas  we  use 
are:  red-blue  merge  algorithms,  a  simple  dynamical  systems  model,  and  local  dynamic  constraints. 
These  tools  permit  us  to  reduce  the  simulation  to  a  plane  sweep  of  a  “  dynamically  annotated" 
slice  of  configuration  space.  We  hope  that  the  paradigm  of  “simulation  as  sweep”  may  be  useful  in 
other  domains. 

We  are  pursuing  an  algorithmic  theory  of  design  for  assembly.  To  this  end  we  are  developing  and 
implementing  algorithms  that  can  analyze  and  generate  designs  for  objects  so  that  they  will  be  easy 
to  assemble.  In  particular,  we  observe  that  real  objects  that  robots  might  assemble  are  typically 
not  rigid.  For  example,  a  Sony  Walkman  is  made  of  plastic  parts  that  snap  together.  Significant 
advances  were  made  in  the  design  of  the  IBM  ProPrinter,  by  replacing  traditional  fasteners  such  as 
screws  with  plastic  parts  that  simply  snap  together.  The  reason  these  plastic  parts  snap  together 
is  that  they  are  flexible :  more  precisely,  they  are  passively  compliant.  This  means  that  when  the 
parts  are  brought  together  and  an  external  force  applied,  the  parts  deform  in  a  prescribed  way. 
More  interestingly,  the  force  required  to  mate  two  parts  may  be  much  less  than  the  force  required 
take  them  apart. 

’  1  Since  we  wish  to  be  able  to  design  and  have  our  robots  assemble  such  objects  given  task-level 
Q  descriptions,  we  must  have  a  systematic  program  for  reasoning  about  and  predicting  their  motions 
n  in  contact.  To  this  end,  Pai  and  Donald  [PD,  DP),  made  precise  a  sufficiently  powerful  notion 
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^flexibility  to  model  the  objects  above,  which  encompasses  several  important  and  complicated 
mechaju§ms.in .mechanical  design  and  automated  assembly:  snap-fasteners,  latches,  ratchet  and 
pawl  mecha^sms,  and  escapements  (see  fig,  1).  We  modeled  the  physics  of  interaction  between 
^Th^^j.biq.j^rts  and  the  environment  (including  their  mating  parts).  Using  these  tools,  we  can 
— p r^e'e'iF '^^evelop  combinatorially  precise  geometric  algorithms  for  predicting  the  motion  of  a 
t'hejot^-object'Ttear  and  in  contact  with  its  mating  part. 

static  mechanics,  as 
for  each  “pawl 

jve  redufce  to  sleeping  an  planar  arrangement  of  algebraic  curves  of  low  degree.  The  connected 
component  of  f$ee  space  defined  in  this  planar  arrangement  has  complexity  0(Ar(n)),  and  can 
.be~constTncted"in  time  0(Ar(n)log2  n)  using  a  red-blue  merge  algorithm  [GSSj.  Here  Ar(n)  is  the 
(almost  linear)  maximum  length  of  (n,  r)  Davenport  Schinzel  sequences  [GSSj.  r  is  a  small  constant 
related  to  the  number  of  times  two  cubic1  configuration  space  constraint  curves  can  intersect.  Our 

*By  “cubic”  we  mean  the  total  degree  of  the  defining  multinomial  is  3.  Our  curves  have  additional  structure,  such 


’  iiexlble  -ob jectilear  and  m  contact  with  its  mating  part. 

vievj.tjieisimulation  problem,  even  with  rotational  compliance  and  quasi-stat 
^  aJ problem  that  can  be  solved  by  careful  reduction  to  a  plane  sweep.  In  particular, 

i ?  .  lL  _  _  1 • .  i  _  ...  ...  .....  .  r  t  i  •  .  _  c  i  .  t . 
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approach  [PD,  DP]  to  modeling  rotational  compliance  and  to  incorporating  frictional  constraints 
leads  to  the  first  formulation  of  the  simulation  prediction  problem  which  permits  a  reduction  of 
motion  prediction  to  plane  sweep.  Our  solution  differs  from  previous  work  on  predicting,  bounding, 
and  planning  rotationally  compliant  motions  with  quasi-static  mechanics  in  that  it  is  (i)  purely 
algebraic ,  and  hence  exact,  (ii)  combinatorially  precise,  in  that  the  computational  complexity  is 
exactly  known,  and  (iii)  requires  no  integration.2 

1.1  Problem  Statement 

We  consider  the  problem  of  moving  a  flexible,  linked  body  M  in  the  plane,  in  a  polygonal  envi¬ 
ronment  Af.  The  flexible  body  M  is  constructed  as  follows:  polygons  Mh,  h  =  l,...,fc,  called 
“pawls”,  are  attached  to  a  root  polygon  Mo,  at  hinge  points  P/,.  Each  hinge  is  coupled  with  a 
spring  of  stiffness  «/,.  (See  Figure  2). 

The  motion  of  the  body  M  consists  of  rigid  translation  of  the  root  polygon  Mq.  The  pawls 
Mh  are  free  to  move  compliantly  as  dictated  by  interactions  with  the  environment  and  the  spring. 

Time  T  will  be  represented  by  the  nonnegative  real  numbers.  A  solution  trajectory  $  for  the 
system  (MM)  is  a  family  of  maps  (<f>o,<f>\,.  ..,<f>k)  where  <j>o  ‘.T  -*  3t2  specifies  the  configuration 
of  the  root  and  each  <f>h  •  T  ->  Sl  specifies  the  orientation  of  pawl  polygon  Mh ,  h  =  1 
Hence  the  global  configuration  of  pawl  Mh  at  time  t  is  given  by  (p(t),<f>h(t)),  where  p(t)  differs  by 
a  constant  offset  from  <f>o(t)  (see  eq.  (1)  below).  We  see  that  the  configuration  space  of  the  system 

ksys 

(MM)  is3  C  =  9?2  x  51  x  •  •  •  x  51. 

The  Simulation  Problem  is  to  determine: 

1.  The  solution  trajectory  3?  :  T  ->  C  of  the  system. 

2.  The  time  of  termination  of  the  motion,  the  cause  of  termination  (such  as  sticking  due  to  fric¬ 
tion,  sticking  due  to  kinematic  constraints,  etc.),  and  the  configuration  of  M  at  termination. 

3.  The  time  history  of  contacts  between  M  and  Af. 

Some  extensions  of  the  simulation  problem  are  considered  in  [DP],  including  the  determination 
of  the  time  history  of  forces  during  the  motion,  and  the  effect  of  uncertainty. 

We  make  the  following  assumptions  about  the  physics  of  object  interactions  and  the  motion  of 
M: 


•  Object  interactions  are  restricted  to  those  between  Mh  and  Af.  In  other  words,  pawls  do 
not  collide  with  each  other,  but  may  collide  with  the  environment  Af.  The  effect  of  this 
assumption  is  to  make  the  motion  of  each  pawl  independent  of  the  motion  of  other  pawls. 
Henceforth  we  shall  consider  the  motion  of  a  single  pawl  Mh- 

as  low-degree  parameterizations,  as  well. 

JNote  that  [Don2,Can2,Bri,FHS]  address  geometric  reachability  issues  for  translationally  compliant  objects,  but 
these  objects  cannot  rotate. 

sThis  is  the  configuration  space  with  no  springs,  but  only  kinematic  constraints.  Introduction  of  springs  means 
that  it  is  not  possible  to  identify  a  rotation  of  2tt  with  0,  since  at  2tr  the  pawl  is  “cocked”.  Hence  the  introduction  of 
dynamics  forces  us  to  pass  to  the  covering  space  3?*+J.  Our  analysis  goes  through  n.atatts  mutandis  for  the  coteung 
space. 
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•  Since  the  root  Mo  is  undergoing  a  rigid  translation,  so  does  the  hinge  point  P/,.  We  shall 
assume  that  this  translation  is  a  straight  line  motion  given  by 

P(0  =  Po  +  P*  (!) 

where  t  is  the  time,  p0  is  the  initial  position  (at  t  =  0)  of  Pi,,  and  p  is  its  velocity. 

•  Stable  contact:  Suppose  the  pawl  is  in  contact  with  a  feature  (edge  or  vertex)  of  the  envi¬ 
ronment  (for  example,  during  sliding).  We  assume  that  if  we  perform  a  small  displacement 
of  the  pawl  away  from  the  environment,  the  torque  on  the  pawl  due  to  the  spring  is  such 
that  the  contact  will  be  restored.  This  assumption  is  no.  very  restrictive  at  all  -  in  fact,  in 
the  face  of  even  the  smallest  uncertainty,  stable  contacts  are  the  only  ones  one  can  hope  to 
observe  in  practice. 

•  Quasi-static  motion:  The  motion  is  assumed  to  be  slow  enough  that  inertial  effects  are  not 
significant.  This  corresponds  to  assuming  that  there  is  no  acceleration  of  the  pawl,  and  hence 
the  forces  on  the  pawl  are  balanced.  The  quasi-static  assumption  is  reasonable  at  small  speeds 
and  is  widely  used  (see,  for  example,  [Whi,Ma,Erd,Don2]). 

•  If  the  pawl  slides  off  A f  into  free  space,  it  may  have  a  residual  torque  due  to  the  spring  being 
cocked.  We  shall  assume  that  the  pawl  rotates  back  towards  its  rest  orientation  at  such  great 
speed  that  p  does  not  change  significantly  during  the  rotation  and  can  be  taken  to  be  constant. 
This,  incidentally,  is  the  “snap”  in  the  snap-fasteners  that  we  wish  to  model.  This  assumption 
may  appear  to  contradict  the  assumption  of  quasi-static  motion,  but  is  in  fact  practically  a 
consequence.  Quasi-static  motion  implies  that  the  root  is  moving  “slowly-enough”  for  the 
forces  to  be  balanced.  Hence,  when  a  pawl  is  in  free  space  and  has  a  residual  torque,  its 
motion  can  be  fast  compared  to  that  of  the  root,  resulting  in  a  “snap”.  This  assumption  can 
be  relaxed  by  assuming  a  linear  relationship  between  the  translation  p  and  the  rotation  (e.g.. 
see  [Can]),  but  we  do  not  deal  with  it  here. 

•  The  forces  of  friction  arising  from  contact  obey  Coulomb’s  Law.  We  further  assume  that 
there  is  a  single  coefficient  of  friction.  This  assumption  is  also  widely  used. 

These  assumptions  define  a  simple  but  adequate  dynamical  system.  We  will  exploit  the  geometry 
of  this  system  extensively  to  obtain  our  results. 

Two  types  of  contact  are  possible  between  the  pawl  Mh  and  a  polygon  in  Af.  Following  the 
convention  of  Lozano-Perez  [LoP]  and  Donald  [Don],  we  say  that  Type- A  contact  occurs  when  a 
vertex  of  A f  touches  an  edge  of  the  pawl;  Type-B  contact  occurs  when  a  vertex  of  the  pawl  touches 
an  edge  of  Af. 

We  can  now  write  the  contact  constraint  equations  for  the  two  types  of  contact,  as  in  [Can]. 
We  shall  index  features  (vertices  and  edges)  of  the  moving  pawl  by  the  subscript  i  and  features  of 
the  polygonal  environment  by  the  subscript  j.  Let  an  edge  of  AAj,  be  represented  by  its  outward 
normal,  n;,  and  its  distance  to  the  hinge  point  along  the  normal,  d;.  Let  pj  be  a  vector  to  the 
contact  vertex  of  Af.  Let  R$  be  the  linear  transformation  which  rotates  a  vector  by  an  angle  9. 
Then  the  type-A  constraint  can  be  written  as 

(pj  -  p)-Rgni  -  d;  =  0.  (2) 
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Similarly,  the  type-B  constraint  can  be  written  as 

(RoPi  +  p)-rij  -  dj  =  0.  (3) 

Where  p,  is  the  vector  from  the  hinge  point  P/,  to  the  contact  vertex  of  The  derivation  of  eqs. 
(2)  and  (3)  has  been  discussed  extensively  in  the  literature,  eg.,  (LoP,  Don,  Can]. 

2  Statement  of  Results 

2.1  Exact  solutions  for  mechanical  simulations 

The  approach  in  [DP]  deviated  significantly  from  earlier  simulation  methods.  A  major  impediment 
to  developing  simulation  systems  has  been  the  apparent  necessity  to  integrate  out  the  differential 
mechanics  in  order  to  determine  the  long-term  behavior  of  the  system.  This  problem  is  exacerbated 
by  the  fact  that  in  many  models  of  rotational  compliance  such  as  the  generalized  damper  (eg.,  [LMT. 
Erd,  Don2,  Don3,  Can2]),  the  resulting  trajectories  are  not  known  to  be  algebraic;  neither  do  •  . 
have  ways  of  computing  algebraic  bounding  approximations  (or  forward  projections).  Hence  the 
traditional  numerical  approach  to  simulating  such  systems  has  been  the  following: 

Typical  Simulation  Algorithm 

1.  Given  a  state  x  of  the  system,  numerically  integrate  the  differential  equation  governing  motion 
of  the  system.  Step  forward  in  time  to  obtain  (approximately)  new  state  x'. 

2.  Perform  collision  detection  either  at  x'  or  along  the  path  from  x  to  x'. 

3.  If  the  constraints  have  changed,  reformulate  the  differential  equation. 

4.  Repeat. 

Numerical  simulation  of  mechanical  systems  is  fraught  with  error,  special  cases,  and  numerical 
problems.  They  are  rarely  combinatorially  precise,  and  almost  never  come  with  guarantees  of 
accuracy  (see  [CDRX]  for  exceptions).  We  show  how  in  the  case  of  our  system,  numerical  simulation 
can  be  avoided,  and  exact  solutions  can  be  obtained.  We  cannot  claim  that  this  can  be  done  in 
general.  However,  our  method  yields,  in  this  case,  computationally  efficient,  exact  solutions,  and 
may  possibly  be  useful  in  other  domains. 

2.2  Computational  complexity 

The  focus  of  our  initial  work  [DP]  was  on  modeling  and  robotics  issues,  and  not  on  the  computational 
geometric  aspects.  Our  first  algorithm,  while  polynomial,  was  naive.  In  this  paper  we  give  a 
considerably  faster  algorithm  by  mounting  a  computational  geometric  attack.  In  addition,  the  new 
algorithm  sheds  light  on  several  interesting  combinatorial  and  structural  issues.  Furthermore,  it 
leads  to  a  systematic  classification  of  special  cases,  and  has  connections  to  the  qualitative  analysis 
of  dynamical  systems. 

More  specifically:  In  [DP],  we  showed  how  our  model  of  compliance  permits  us  to  obtain 
algebraic,  closed- form  solutions  to  simulation  problems  for  a  rotationally  compliant  object,  and 
how  this  leads  to  exact  algorithms  for  analyzing  designs  for  assembly.  In  particular,  the  linear 
map  p(t)  is  given  by  eq.  (1),  and  once  we  “rationalize”  rotations  via  the  standard  substitution 
u  =  tan  |,  each  map  <f>h  is  piecewise-cubic.  The  naive  algorithm  can  be  summarized  as  follows. 
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Naive  Exact  Algorithm  [DP] 


1.  Given  a  state  x  of  the  system,  possibly  subject  to  a  configuration  space  constraint  /  (/  has 
form  eq.  (2)  or  (3)),  calculate  a  local  solution  trajectory  $  respecting  /.  $  will  be  a  linear 
or  cubic  curve  in  the  configuration  space. 

2.  The  configuration  space  constraints  are  algebraic  surfaces  of  bounded  degree.  Intersect 
with  the  surfaces  to  perform  exact  collision  detection. 

3.  A  collision  results  either  in  termination  of  the  motion  or  in  a  change  of  constraint.  Update  / 
if  necessary. 

4.  Repeat. 

Suppose  the  obstacles  have  m  vertices  and  the  moving  object  (root  and  one  pawl)  has  l  vertices. 
Let  n  =  ml  be  the  measure  of  the  geometric  complexity.  In  [DP]  we  were  able  to  show  that  this 
naive  algorithm  runs  in  time  0(n2  log  n).  For  k  pawls,  the  complexity  of  the  naive  algorithm  was 
0(kn?  log  n). 

In  this  paper,  we  give  a  new  simulation  algorithm  that  is  also  exact,  and  runs  in  time  0(fcAr(n)  log2 
Our  method  reduces  the  simulation  problem  to  a  plane  sweep  of  an  arrangement  of  algebraic  curves 
in  configuration  space.  To  obtain  this  result  we  prove  the  following  points.  For  simplicity,  assume 
below  that  k  =  1  ,  and  hence  configuration  space  C  =  ft2  x  S1. 

1.  The  simulation  never  leaves  a  connected  component  F0  of  free  configuration  space. 

2.  The  solution  trajectory  $  of  the  system  is  piecewise  cubic  in  the  configuration  space,  and  the 
dynamics  may  be  reduced  to  erecting  cubic  “local”  configuration  space  constraints. 

3.  Translational  motion  of  the  root  polygon  (eq.  (1))  restricts  the  reachable  configurations  to  a 
2D  cylinder  Y  CC. 

4.  Y  embeds  in  C  as  follows: 

Y  ^  S2x5‘  ,  . 

M)  -  (P(t),0).  [  ’ 

where  t  moves  along  the  axis  of  the  cylinder.  Hence  we  view  Y  as  3?  x  S1.  The  time  evolution 
t  6  T  of  the  system  corresponds  to  the  ft  factor.  Hence  the  solution  “sweeps”  along  the 
cylinder  Y  in  the  direction  of  the  axis. 

5.  The  configuration  space  constraints  are  manifest  as  cubic  curves  on  Y . 

6.  As  we  sweep  the  cylinder  Y ,  a  simple  dynamical  system  models  the  motion  of  the  configuration 
point  on  the  configuration  space  constraints.  The  orbits  of  this  system  are  piecewise  algebraic 
of  bounded  degree. 

7.  Parameterize  Y  to  the  plane  (this  only  takes  2  charts).  Then  F  =  Y  n  Fh  is  defined  by  a 
planar  arrangement  of  cubic  curves. 
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8.  F  has  size  0(Ar(/t))  and  can  be  constructed  in  time  0( Ar(n)log2  n)  using  a  red-blue  merge 
algorithm,  as  described  in  [GSS). 

9.  We  can  compute  the  solution  $  by  a  plane-sweep  of  the  slice  F,  i.e.,  by  sweeping  a  planar 
arrangement  of  cubic  curves.  This  allows  us  to  solve  the  motion  prediction  problem  exactly 
in  0(Ar(n)  log2  n)  overall  time. 

Hence  we  prove 

Theorem  2.1  The  Simulation  Problem  defined  above  can  be  solved  in  time  0(Ar(n)log2  n)  and 
space  0(Ar(n)),  where  r  is  a  small  constant. 

3  Details,  Analysis,  and  Description  of  our  Approach 

з. 1  Computing  the  Connected  Component  of  Free  Space 

We  can  only  sketch  the  idea  of  our  proofs  here.  Consider  the  motion  of  a  single  pawl  ,Vf whose 
translation  is  governed  by  eq.  (l).  As  is  well  known,  if  we  “rationalize”  rotations  using  the  standard 
substitution  u  =  tan|,  the  n  constraints  given  by  eqs.  (2)  and  (3)  are  manifest  as  algebraic  ruled 
surfaces  {  /i,  in  a  3D  configuration  space  with  coordinates  (x, y,  u).  These  constraints  are 

simultaneously  linear  in  the  position  parameters  x  and  y  and  quadratic  in  the  rotational  parameter 

и.  Each  surface  is  only  “applicable”  for  some  range  of  orientations  [t<o,  uj],  by  which  we  effectively 
mean  that  the  surface  only  “exists”  for  u  in  this  range  (see  [Don]).  See  fig.  3,  from  [Bro].4 

I  et  u  be  a  vector  along  the  u-axis  (think  of  u  as  (0, 0, 1)).  Now,  the  constraint  of  pure  translation 
(eq.  (1))  of  the  hinge  point  P/,  of  the  pawl  Mh  restricts  any  possible  evolution  of  the  system  to  lie 
in  a  “plane”  (2D  subspace)  of  (x,y,  u)- space.  We  call  this  ‘  plane”  Py\  it  has  “normal”  u  x  (p,  0), 
and  it  corresponds  to  a  chart  for  the  cylinder  Y  discussed  in  sec.  2.2.  We  note  that  furthermore, 
at  time  t,  the  state  of  the  system  is  constrained  to  lie  on  a  line  L(t)  parallel  to  u  in  the  plane  Py. 
This  is  the  line  of  points  (p(i),u),  for  «  6  S.  The  line  L(t)  sweeps  across  the  plane  in  direction 
(p,  0)  as  t  increases,  and  thus  we  call  L(t)  the  sweep  line. 

Hence,  a  natural  coordinate  system  for  the  plane  Py  is  given  by  (f,u).  As  time  t  increases, 
the  vertical  line  L(t)  sweeps  across  Py.  This  line  contains  the  state  of  the  system.  It  is  our 
task  to  calculate  the  u  coordinate  as  t  evolves  (i.e.,  increases).  Now,  Py  has  degree  1  and  hence 
when  intersected  with  a  constraint  f,  we  obtain  a  cubic5  curve  segment  7;  in  the  ( t ,  u)  plane.  So 
all  the  configuration  space  constraints  are  manifest  as  an  arrangement  of  cubic  curve  segments 
{ 7i > •  •  •  > 7n }  in  this  plane,  where  7;  =  /;  D  Py  ( i  =  1, ...,n).  In  our  algorithm,  the  sweep  line 
sweeps  across  this  planar  arrangement  of  curves,  and  as  we  sweep,  we  compute  the  trajectory  of 
the  system.  “Events”  caused  by  crossing  the  curves  7,'  will  modify  the  trajectory,  as  we  discuss 
below. 

A  priori,  the  arrangement  of  curves  can  have  complexity  0(n2),  and  in  fact,  the  set  of  free 
configurations  in  Py  can  also  have  size  fl(n2)  in  the  worst  case  (see  [KS,GSS]).  However,  we  can 
directly  apply  the  results  of  [GSS]  as  follows.  We  note  that  the  system  begins  at  some  configuration 
z0  €  Py.  z0  lies  in  one  connected  component  F  C  Py  of  free  space  and  the  resulting  path  can 
never  leave  F  since  it  corresponds  to  a  physical  simulation.  [GSS]  show  that: 

*We  thank  R.  Brost  for  providing  us  with  these  figures,  from  [Bro]. 

5 In  fact,  each  curve  7;  is  simultaneously  quadratic  in  u  and  linear  in  t. 


Lemma  3.1  [GSS]  The  combinatorial  complexity  of  F  is  0(Xs+2(n)),  and  we  may  precompute 
it  (i.e.,  compute  it  before  our  plane  sweep)  in  time  0(AJ+2(n)  log2  n).  Here  s  is  a  small  constant 
bounding  the  number  of  times  that  two  configuration  space  constraint  curves  7,  and  7^  can  intersect. 

Recall  Ar(n)  is  the  (almost  linear)  maximum  length  of  (n,r)  Davenport  Schinzel  sequences 
[GSS],  [HS,ASS].  It  is  very  likely  that  for  a  wide  variety  of  situations  encountered  in  practice  (see. 
eg.,  [Bro])  that  s  <  1.  However,  it  is  certain  that  a  worst  case  bound  is  s  <  d2  for  curves  of  degree 
d.  Note  that  s  <  1  would  tighten  our  bound  to  space  0(na(n))  and  time  0(7ia(n)log2  n)  [HS], 

3.2  Sweeping  the  Connected  Component  of  Free  Space 
3.2.1  Kinematics 

We  postpone  our  discussion  of  friction  until  sec.  3.3.  Here  we  treat  the  frictionless  case  first,  defining 
six  types  of  local  geometric  events,  called  “sweep  events"  that  will  be  detected  and  handled  during 
the  plane  sweep.  These  events  are  purely  kinematic,  i.e.,  they  do  not  depend  on  friction. 

Having  computed  the  connected  component  F  C  Py  containing  the  initial  configuration,  we 
now  sweep  F  with  the  line  L(t)  in  the  (t,  u)-plane.  By  an  abuse  of  notation  we  will  now  let  */,, 
7 j  etc.  denote  the  curves  bounding  F  that  we  precomputed  (along  with  their  intersections)  in 
sec  3.1.  We  now  define  the  following  sweep  events:  (i)  translational  collision ,  (ii)  sliding  collision, 
(iii)  jamming  due  to  incompatible  kinematics.  The  sweep  algorithm  will  detect  sweep  events.  Each 
event  will  be  handled,  by  which  we  mean  that  the  solution  trajectoiy  we  compute  may  be  modified. 
In  between  events,  the  trajectory  is  piecewise  algebraic. 

First  suppose  there  are  no  obstacles.  Then  the  trajectory  of  the  system  will  stay  at  u  =  0 
rn-the  (f,u)-plane  (i.e.,  the  orientation  of  the  pawl  will  not  change).  Call  the  point  z(t )  on  L[t) 
representing  the  state  of  the  system  the  sweep  point.  So  z(t)  is  the  solution  trajectory  we  compute. 

Now,  in  the  presence  of  obstacles,  sweep  events  occur  as  the  the  sweep  line  crosses  the  curves 
{7;}.  These  events  are  enumerated  in  figs.  4-6.  We  can  explain  the  trajectory  computation 
algorithm  like  this:  the  dynamical  system  described  in  sec.  1.1  has  the  following  geometric  inter¬ 
pretation  in  slice  Py.  As  the  sweep  line  L(t)  crosses  the  (<,u),  plane,  the  the  u-coordinate  u(t)  of 
the  sweep  point  z(t)  £  L(t)  moves.  In  the  plane  Py ,  the  line  u  =  0  is  an  attractor,  and  we  imagine 
a  vector  field  on  Py  parallel  to  the  u-axis  and  pointing  towards  the  t-axis.  Hence  the  attracting 
vectors  are  parallel  to  -i u  for  u  >  0  and  parallel  to  4-u  for  u  <  0.  The  curves  7,  act  as  (holonomic) 
constraints.  The  sweep  point  cannot  cross  these  curves,  but  it  can  follow  them  as  L(t)  moves.  They 
can  prevent  motion  of  the  sweep  point  from  attaining  u  =  0. 

For  example,  see  fig.  4.  If  the  trajectory  is  at  the  u  =  0  position  and  the  sweep  point  z(t) 
encounters  a  constraint  7,,  then  the  sweep  point  complies  to  the  constraint  and  is  forced  to  move 
away  from  the  zero  line  ( u  becomes  positive  here).  This  corresponds  to  a  pure  translational  collision, 
followed  by  a  continued  motion  of  the  root  which  “cocks”  the  pawl  against  an  obstacle.  During 
this  motion,  the  sweep  point  follows  7 ,.  If  a  new  constraint  7^  is  reached,  then  the  sweep  point 
slides  along  the  curve  7;  in  turn.  This  corresponds  to  a  sliding  collision:  while  sliding  on  constraint 
7i,  the  pawl  hits  constraint  7r  The  motion  continues,  following  7;  compliantly.  Hence  the  sliding 
collision  can  result  in  a  constraint  change.  Finally,  if  the  sweep  point  is  following  a  curve  7,  which 
crosses  u  -  0,  the  trajectory  breaks  contact  there  and  continues  along  the  t-axis.  This  event  is  a 
“dual”  subcase  of  type  (i). 


As  can  be  seen  from  fig.  4,  some  constraint  changes  result  in  jamming  due  to  incompatible 
kinematics.  This  occurs  as  follows.  Define  the  outward  normal  ij,  of  a  curve  7,  to  point  into  free 
space  F.  Let  t  be  a  unit  vector  in  the  positive  f-direction.  Jamming  occurs  at  7,  fl  7;  when  both 
the  inner  products 


rji't  and  r)j -t  (5) 

are  negative.  At  this  point  the  simulation  is  terminated,  because  further  motion  is  impossible. 

Pure  translational  collision  events  can  occur  where  a  curve  7,  intersects  the  line  u  =  0.  Sliding 
collisions  can  occur  when  two  boundary  curves  of  F  intersect,  i.e.,  at  7,  fl  7 }.  Jamming  events  can 
occur  when  both  normals  at  7,  n  7_,  point  in  the  (-t)-direction.  A  non-jamming  sliding  collision 
causes  a  change  of  constraint  (i.e.,  the  sweep  point  now  follows  7 ;  instead  of  7,).  It  is  clear  that 
sweep  events  of  type  (i),  (ii),  and  (iii)  are  local  geometric  conditions  and  can  be  detected  and 
handled  while  sweeping  the  line  L(t)  over  F.  Similarly,  it  is  clear  that  modifying  the  trajecton 
z[t)  at  a  sweep  event  can  be  done  in  0(1)  time. 

3.2.2  Snapping  Free  or  Jamming  on  A  Single  Constraint 

We  now  define  the  sweep  events  (iv)  snapping  free  from  and  (v)  jamming  on  a  single  constraint. 
Suppose  the  sweep  point  is  following  a  constraint  curve  7.  A  singularity  occurs  at  \ertical  tangencies 
of  7.  See  fig.  5.  Assume  wlog  that  7  lies  in  the  halfplane  u  >  0.  There  are  two  possibilities.  If 
the  F  is  concave  at  the  singularity,  then  the  sweep  point  has  been  following  the  ‘‘upper"  branch 
of  the  curve.  After  the  singularity,  the  sweep  point  follows  the  vector  field  attracting  it  towards 
u  =  0.  That  is,  the  sweep  point  moves  parallel  to  the  u-axis  toward  the  f-axis.  It  stops  at  the 
first  new  constraint  curve  it  hits  while  moving  away  from  the  singularity  towards  the  line  u  =  0.  If 
no  constraints  are  encountered,  it  stops  at  u  =  0.  This  motion  corresponds  to  the  pawl  “snapping 
free”  from  a  single  constraint  edge.  It  executes  an  instantaneous  pure  rotation  towards  the  zero 
position.  If  another  constraint  is  in  the  wayr  then  it  stops  there. 

If  F  is  convex  at  the  singularity,  then  no  further  motion  is  possible,  and  the  motion  jams  theiv 
on  a  single  constraint.  At  this  point  the  simulation  is  te-minated. 

Clearly,  singularity  (vertical  tangency)  is  a  local  geometric  condition  that  can  be  detected  during 
the  plane  sweep  of  F,  since  each  curve  is  algebraic. 

There  is  one  more  kinematic  sweep  event  that  is  “dual"  to  type  (iii)  jamming  due  to  incompatible 
kinematics.  It  is  type  (vi)  snapping  free  from  a  vertex.  It  occurs  at  a  constraint  change  7,  n  7^  (i.e.. 
the  sweep  point  is  following  a  curve  7,,  and  it  hits  another  curve  7,).  However,  in  this  case,  both 
the  outward  normals  rj,  and  rjj  point  in  the  positive  t-direction.  That  is,  the  dot  products  in  eq. 
(5)  are  both  positive.  In  this  case,  the  sweep  point  “snaps  free”  from  7,  n  ~j3  and  moves  vertically 
towards  the  attractor  u  =  0.  The  snapping  free  happens  just  as  in  event  (iv)  above.  Snapping  free 
from  a  vertex  corresponds  to  the  situation  where  suddenly  there  are  no  holonomic  constraints  on 
the  pawl,  so  it  can  move  towards  its  rest  position  u  =  0.  Conceptually,  there  is  little  difference 
from  event  (iv)  (snapping  free  from  one  constraint). 

It  is  clear  that  sweep  events  of  type  (iv),  (v),  and  (vi)  are  local  geometric  conditions  and  can  be 
detected  and  handled  while  sweeping  the  line  L(t)  over  F.  It  is  clear  that  modifying  the  trajectory 
z(t )  at  a  sweep  event  can  be  done  in  0(1)  time.  To  see  that  six  event  types  suffice,  simply 
enumerate  the  ways  7,  can  (a)  intersect  7 (b)  intersect  u  =  0,  or  (c)  become  vertical.  Hence  we 
have, 
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Lemma  3.2  There  are  six  types  of  kinematic  sweep  events,  a3  described  above.  There  are  0(AJ+2(n)) 
such  events  overall.  Each  event  is  a  local  geometric  condition  that  can  be  detected  and  handled  in 
0(1)  time.  The  output  trajectory  is  piecewise  algebraic  with  at  most  0(Xs+2(n))  pieces  and  degree 
at  most  3. 

Corollary  3.3  A  plane  sweep  of  F  that  handies  all  kinematic  sweep  events  can  be  performed  in 
time  0(\s+2(n)  log  AJ+2(n)).  This  sweep  solves  the  frictionless  simulation  problem  (given  F)  for  a 
single  pawl. 

3.3  Friction 

We  now  briefly  describe  how  friction  is  handled.  From  the  analysis  in  [DP],  the  following  is  clear:  for 
each  configuration  space  surface  /,  we  can  define  two  constraints  g,  and  h ,  which  are  also  algebraic 
surfaces  of  the  same  degree  as  /,-.  g ;  and  hi  depend  on  the  direction  of  assembly  p  in  (1). 

The  surfaces  g,  and  h,  break  up  /,  into  sliding  and  sticking  regions.  We  call  these  qualitative 
dynamical  regions  (QDR’s),  by  analogy  with  [BD].  In  a  sliding  region,  motion  is  possible  as  t 
increases.  In  a  sticking  region,  equilibrium  results,  and  no  further  motion  is  possible  (compare 
work  on  translational  compliant  motion,  eg,  (Don2,  Bri]).  The  analysis  to  obtain  this  result  is 
based  on  an  interesting  mechanical  analysis  which  we  cannot  include  for  reasons  of  space;  however, 
see  [DP].  Now,  when  we  intersect  fi  with  the  plane  Py  to  obtain  a  curve  7,-  (see  fig.  6)  we  obtain 
a  ID  slice  of  these  qualitative  dynamic  regions  (sliding  and  sticking).  Now,  the  Bezout  bor  .d 
gives  an  a  priori  0(1)  bound  on  the  number  of  QDR’s  per  surface.  However,  in  fact,  the  special 
structure  of  our  constraints  ensures  that  there  will  be  at  most  3  QDR’s  per  connected  curve  7 , 
on  the  boundary  of  F.  Type-B  constraints  have  (at  most)  one  sliding  region  surrounded  by  two 
sticking  regions.  Type-A  constraints  have  (at  most)  one  sticking  region  surrounded  by  two  sliding 
regions. 

Now,  we  define  a  sever. :h  type  of  sweep  event,  (vii)  a  sticking  event  as  follows.  Suppose  the 
sweep  point  is  following  a  curve  7,.  If  it  enters  a  sticking  region  on  the  curve,  then  equilibrium  is 
reached  and  the  simulation  is  terminated.  Entry  into  the  sticking  region  corresponds  to  crossing 
another  algebraic  curve  h ,  or  g„  and  hence  is  a  local  geometric  event  that  can  be  detected  and 
handled  during  the  sweep.  Note  that  g ,  and  h,  apply  only  to  /,  and  do  not  affect  any  other  surface 
fj,  and  hence  we  call  them  local  dynamic  constraints. 

Finally  we  must  slightly  modify  our  kinematic  plane  sweep.  After  a  pure  translational  or  pure 
rotational  collision  with  a  curve  7;,  we  first  check  to  see  whether  we  are  in  a  sticking  or  sliding 
region  on  that  curve.  If  it’s  a  sticking  region,  we  terminate  the  simulation  in  equiliorium,  otherwise 
we  proceed  as  above,  (sec.  3.2).  To  summarize, 

Proposition  3.4  There  are  0(1)  sticking  events  per  constraint  curve  7,.  Each  occurs  at  the  in¬ 
tersection  0/7,-  with  a  local  dynamic  constraint  (another  algebraic  curve)  in  Py. 

This  completes  our  proof  of  the  main  theorem  2.1. 

3.4  Summary 

Red-blue  merge  algorithms  allow  us  to  construct  a  connected  component  of  free  space  F  containing 
the  initial  configuration  in  time  0(AJ+2(n)log2  n).  We  desire  to  simulate  a  simple  dynamical 


9 


system  within  F.  We  compute  the  simulation  trajectory  using  t  plane  sweep  of  F.  To  do  this,  we 
augment  F  with  a  vector  field  (defining  an  attractor  at  u  =  0)  and  we  “annotate”  each  curve  7, 
on  the  boundary  of  F  with  certain  “markings”  at  which  the  dynamical  behavior  of  a  sweep  point 
traversing  7,  can  change.  The  markings  break  the  curve  into  a  finite  number  of  subsegments.  The 
markings  are:  (a)  sticking/sliding  transition,  (b)  vertical  tangency,  and  (c)  intersection  with  the 
line  u  -  0.  Each  marking  is  determined  by  the  intersection  of  7,  with  a  line  (such  as  u  =  0)  or 
a  curve  (g,  or  ht),  or  by  vertical  tangency.  Hence  each  marking  is  algebraic  and  there  are  0(1) 
markings  per  curve.  Finally,  at  an  endpoint  of  7,  we  have  an  intersection  with  the  next  cubic  curve 
7 j  on  the  boundary  of  F. 


4  Conclusion 

We  considered  the  problem  of  simulating  the  motion  of  compliantly  connected  rigid  bodies  in 
frictional  contact  with  obstacles  during  an  assembly  motion.  While  compliant  motion  has  been 
considered  in  a  computational  geometric  setting  for  pure  translations  [Don2,  Eri,  FHS],  the  problem 
for  rotational  compliance  has  proved  resistant  to  solution.  We  showed  that  unlike  many  simulation 
problems  for  rotational  bodies,  we  can  obtain  exact  solutions  without  integration.  We  improve  on 
our  earlier,  naive  0(n2  log  n)  algorithm  [DP]  by  the  introduction  of  several  techniques.  The  key 
ideas  we  use  are:  red-blue  merge  algorithms,  a  simple  dynamical  systems  model,  and  local  dynamic 
constraints.  These  tools  permit  us  to  reduce  the  simulation  to  a  plane  sweep  of  a  “  dynamically 
annotated"  slice  of  configuration  space.  More  specifically:  First,  we  precompute  the  connected 
component  of  the  simulation.  This  component  of  free  space  has  low  combinatorial  complexity  (by 
Davenport-Schinzel  arguments)  and  can  be  computed  efficiently  using  a  red-blue  merge  algorithm 
[GSS].  Next,  we  reduce  the  simulation  problem  to  a  plane  sweep  of  F.  To  do  this,  we  first  introduce 
additional  local  constraints  (0(1)  per  curve  bounding  F),  an  attractor  at  the  rest  orientation  u  =  0. 
and  a  corresponding  attractive  vector  field  on  F.  These  constructions  allow  us  to  view  the  plane 
sweep  as  a  simple  dynamical  system.  This  in  turn  permits  us  to  bound  the  number  of  sweep  events 
by  0(A,4.2(n)),  which  yields  our  main  result.  This  is  one  of  the  first  combinatorially  efficient,  exact 
solutions  to  any  simulation  problem  for  a  rotational  mechanical  system,  or  for  rotational  compliant 
motion. 

There  are  many  problems  left  open  for  the  future.  First,  we  would  like  to  extend  our  work  to 
“trees"  of  compliantly  connected  bodies.  Second,  we  believe  our  work  can  be  extended  to  incorpo¬ 
rate  uncertainty  in  the  initial  conditions  and  in  the  control.  This  result  would  be  of  considerable 
interest,  since  it  would  permit  imulation  of  a  differentia*  inclusion.  Exact  simulation  does  not  take 
into  account  the  uncertainty  (eg.,  the  impossibility  of  a  comprehensive  description  of  the  dynamics 
of  a  system),  nor  error  in  actuation.  We  view  the  introduction  of  a  more  realistic  mechanical  model 
(rotationally  compliant  bodies)  as  a  step  in  this  direction.  We  feel  that  the  key  property  that  al¬ 
lowed  us  to  reduce  the  local  dynamics  to  a  plane  sweep  is  a  kind  of  “monotonicity”  that  is  inherent 
in  our  system.  It  is  our  hope  that  other  “monotonic”  systems  (and  even  differential  inclusions) 
may  be  simulated  using  the  concept  of  “simulation  as  sweep.”  See  [BD]  for  work  in  this  direction. 
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Figure  1:  Examples  of  compliantly  connected  rigid  bodies. 


Figure  2:  Linked  body  M  moving  among  A f. 


Brost  [Bro]).  The  sweep  plane  L(t)  intersects  the  cspace  obstacles  in  a  planar  arrangement 
of  cubic  curves. 


Figure  4:  Sweep  events:  translational  collision,  sliding  collision,  and  jamming  due  to  in¬ 
compatible  kinematics. 


Figure  5:  Sweep  events:  Snapping  free  and  jamming  on  a  single  constraints. 


Figure  6:  Sticking  events  and  qualitative  dynamical  regions. 


